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ABSTRACT 

Three-axis attitude determination is equivalent to finding a coordinate transformation matrix which transforms a 
of reference vectors fixed in inertial space to a set of measurement vectors fixed in the spacecraft. The atti- 
tude determination problem can be expressed as a constrained optimization problem. The constraint is that a 
coordinate transformation matrix must be proper, real, and orthogonal. A transformation matrix can be thought 
of as optimal in the least-squares sense if it maps the measurement vectors to the reference vectors with minimal 
2-norm errors and meets the above constraint. This constrained optimization problem is known as Wahba’s 
problem. Several algorithms which solve Wahba’s problem exactly have been developed and used These algo- 
rithms, while steadily improving, are all rather complicated. Furthermore, they involve such numerically unstable 
or sensitive operations as matrix determinant, matrix adjoint, and Newton-Raphson iterations. 

This paper describes an algorithm which minimizes Wahba’s loss function, but without the constraint. When the 
constraint is ignored, the problem can be solved by a straightforward, numerically stable least-squares algorithm 
such as QR decomposition. Even though the algorithm does not explicitly take the constraint into account, it still 
yields a nearly orthogonal matrix for most practical cases; orthogonality only becomes corrupted when the sen- 
sor measurements are very noisy, on the same order of magnitude as the attitude rotations. The algorithm can be 
simplified if the attitude rotations are small enough so that the approximation sinO = 0 holds. 

We then compare the computational requirements for several well-known algorithms. For the general large- 
angle case, the QR least-squares algorithm is competitive with all other known algorithms and faster than most. 
If attitude rotations are small, the least-squares algorithm can be modified to run faster, and this modified algo- 
rithm is faster than all but a similarly specialized version of the QUEST algorithm. 

We also introduce a novel measurement averaging technique which reduces the n -measurement case to the two 
measurement case for our particular application, a star tracker and earth sensor mounted on an earth-pointed 
geosynchronous communications satellite. Using this technique, many n -measurement problems to reduce to 
< 3 measurements; this reduces the amount of required calculation without significant degradation in accuracy. 

Finally, we present the results of some tests which compare the least-squares algorithm with the QUEST and 
FOAM algorithms in the two-measurement case. For our example case, all three algorithms performed with 
similar accuracy. 


The authors are with Hughes Aircraft Company, Bldg El, MS D110, POB 92919, Los Angeles, CA 90009 
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1. INTRODUCTION 

This paper discusses a new sub-optimal algorithm for attitude determination. It also introduces a novel measure- 
ment averaging technique which effectively reduces the number of vector measurements that must be processed 
by any attitude determination algorithm. It is organized as follows: first a brief statement of the attitude deter- 
mination problem is given, followed by a formal statement of Wahba’s attitude determination problem. In Sec- 
tion 2 we introduce a new suboptimal least-squares algorithm which minimizes Wahba’s loss function, but 
without the orthogonality constraint on the attitude matrix solution. In Section 3 the computational requirements 
for the new algorithm are presented and compared with several other attitude solutions (optimal & suboptimal). 
Section 4 discusses a technique for reducing the number of vector measurements. Finally, Section 5 presents 
simulation results for a specific example of a geosynchronous communications satellite with a star tracker and an 
earth sensor. We end with a brief conclusion. 

Attitude Determination Problem Statement 

Consider a set of reference vectors r, , i = 1 , • ■ • , » expressed in an inertially defined coordinate system I. 
Consider the same set of vectors, but denoted s, , / = 1 . • • • , « when expressed in a spacecraft body defined 
coordinate system B . These vectors are related by the attitude (or direction cosine) matrix A , i.e. 

Si = Art i = l, ■ ■ • , n (u 

In one application, for example, the measurement vectors 5, would be provided by earth sensor and star tracker 
measurements (corrupted by error sources such as noise and biases) while the reference vectors r i would 
correspond to known directions of the stars and earth nadir expressed in /. 

The vectors s t and r ( (for i = 1 , • • • , n) can be concatenated to form the columns of matrices 

5 « 1*1 I *2 I • • I R = I r 2 I ' ' ' I r »j- ^ 

Then (1) can be written as one matrix equation 

s=A* (3) 

where 5 and R are 3xn matrices and A is a 3x3 proper real orthogonal matrix [1], i.e. 

A T = A~ l & dei(A) = l ( 4 ) 

Since A satisfies the properties of (4), it represents a rotation transformation which preserves the lengths of vec- 
tors and the angles between them. 

The problem is to find an estimate A of the attitude matrix A using the measurement matrix S and the reference 
matrix R (both possibly corrupted by noise). It is a fundamental fact that at least two non-collinear vectors are 
needed to determine attitude: thus, it is necessary that n > 1 to obtain a solution. 

The problem thus described has a long history «3]-[14]). A number of solutions have been proposed, both 
approximate and optimal. Approximate algorithms such as TRIAD cannot accommodate more than two obser- 
vations and even throw away part of this information; therefore, they don’t provide an optimal estimate of the 

attitude. 

Optimal algorithms, on the other hand, compute a best estimate of the spacecraft attitude based on a loss func- 
tion which takes into account all n measurements. One particular loss function which has found a prominent 
place in the literature is the so-called Wahba loss function, which was first proposed by Wahba in 1965 [2]: 

LC4)=7i>ilh, -4r,ll!=Tl| - A) A * (5) 

2 1=1 1 

where II • H 2 denotes the vector 2-norm, A = diag (a , , a 2 , ■ ■ • , «*„). and the a 4 , i = 1 , • • • , n are non- 
negative weights, whose sum can be set to unity without loss of generality (and will be in the sequel). 
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Wahba’s Problem 

Wahba’s problem is formally stated as follows: Find a 
minimizes the cost function (5). 


proper real orthogonal matrix satisfying (4) which 


Solutions to Wahba’s problem 

a mvoh^ trrir' ,rera d'si 

Markley s SVD algorithm [6] provides a very robust method for solving Wahba’s Droblem it is 

technique; simulations show no loss of accuracy in most ca^s * “ ncmmi usin « ^ 

Another solution recentiy described is the polar decomposition (PD) algorithm of Bar-Itzhack H21 As th„ 

tJ^SSST We eXP ‘ 0re USC «**- » minimize (5, whi.e ..axing 

2. THE NEW SUBOPTIMAL ALGORITHM 

i USed 10 0b,ain “ approxi ™ K ***» •» *e problem posed in Section 

in ^ 


2.1 General Case 

Consider the attitude matrix A of (1). We wish to estimate A using r, and (for / = 1 • 

Equation (3), the problem we address is ‘ ’ 


,n,n> 3). Given 


minimize ||S - Af||| 


( 6 ) 


over all possible A. The objective function of (6) is equivalent to Wahba’s loss function with all weights a set 
leas^Ljuares S esthna tor i^imizing L^ecTve tocS^nty^ ^ Wdghted ta “ MW case ‘ 


A = tf? + 


( 7 ) 
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where R* denotes the pseudo-inverse of*. If the columns of* are linearly independent (as they would be with 
>3 nonredundant measurements), R + can be written 

/r = j? t [/w? 7 ') 1 ^ 

In pracUce, radter than dtrecdy computing (8), it is much more numerically robust and computationally efficient 
u, perform an orthogonal triangulanzaUon of R ; from this the attitude estimate, rf . can be computed. An ortho- 
normal matrix Q exists which transforms R to an lower triangular matrix T: 

= [r o] W 

Ref. [15] describes some standard, numerically stable algorithms exist for computing the jwhogonal 

.inn of r- two of the more popular algorithms are Householder rotations and modified Gram-Schmidt. Equation 

9 is slightly different from the "usual" orthogonal triangular! zation in two ways: first, m the more “P. 

O^oufd operate from the left instead of the right and F would be upper instead of lower 

VnomiTis perturbed because we already used the symbol 1? and here we use F to represent the matrix that 

would usually be called R . 

Now, partitioning Q as [ Q i Q 2 1. yields 


4 


•] 


el 


= rer 


We now show how this factorization can be used to minimize the 2-norm of E _S AR. Denote 

sq = [c d] 


( 10 ) 


(ID 


Then, calculate 


EQ 


= [c - at 0 ] 


( 12 ) 


(13) 


So, the least squares solution is obtained by choosing A to satisfy 

Ar = C or a = cr 1 

which is a matrix equation whose matrix-valued solution can be obtained using standard techniques from linear 
which a mauix eq algorithm for solving the linear least squares problem (6). Equation 

SEE2S? fm^eSon problem, n cau i used re updare each rime srep of a recursive 

algorithm such as a Kalman Filter, such as in [11]. 

Advantages of the General Least-Squares Algorithm 

(1) The algorithm can be carried out using well-known, numerically stable algorithms. 

Disadvantages of the General Algorithm 

(1) Implementing the QR decomposition requires a relatively large number of calculations in the general 
case, so the algorithm trades speed for numerical robustness. 

m solution technique ignores the constraints of (4); thus the estimated attitude matrix will not neces- 
2riW bet we atdtude^matrix (i.e. orthogonal). This can be alleviated by using the orthogonalization pro- 
J f B Twhack [11] More importantly, as sensor errors approach zero the estimated attitude matrix 
wffiTpp^cToSgolly . TOS is because^ die leusl-squares algoriitun minimizes ihe objective funcuon 
of ffiv since the true attitude matrix zeros this objective function, in the error-free (no noise) case, th 
list squares solution will equal the exact solution to Wahba’s constrained problem. We have observed 
this in a number of simulations. 

(3) The algorithm is only usable when three or more (non-collinear) measurements are avatlable; otherwise 

the inverse of (8) doesn’t exist. . 

c wtnrv' The General least-squares algorithm does not appear to be very interesting in its own right; its main 
fnterwHs that in the Special case of small attitude rotations it can be simplified, yielding a very attractive algo- 
rithm. We discuss this below. 
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2.2 Small Rotations Case 

If small attitude rotations are assumed, the attitude matrix A of (1) can be written as 


a = 


1 y -B 

-V 1 <j> 


( 14 ) 


where <j>, 0, and y are the usual Euler angles and are the quantities we wish to estimate (all Euler angle sets are 
essentially equivalent for small angles; these are the so-called body roll, pitch, and yaw pointing errors). 

Combining Equations (1) & (14) as in Bar-Itzhack [11], the least-squares problem (6) reduces to: 


where 


Si - T ! 

s 2 -r 2 


. & small = 


llinafl 

“ Rsmantyl 

0 

~ r n 

r X2 

r 13 

0 

*\\ 

~~ r 12 

'‘li 

0 

0 

^ r 23 

r 22 

r 23 

0 

'21 

~ r 22 

r 2l 

0 

6 

~ r n3 

r n2 

r m 3 

0 

'*1 



0 


(15) 


and 04 


Equation (15) represents a linear measurement equation where the parameters to be estimated are the desired 
body roll, pitch, and yaw angles. The least squares attitude estimate in this case is given by 


® ^ small ^ small ~~ ^ small ^sr 


(16) 


Equation (16) gives the least-squares solution to the linear system of equations in (15); a solution exists for n^2 
measurements. Again, instead of computing (16) directly, a QR decomposition of R sma ii ls used calculated 

the attitude solution. More explicitly, there exists an orthonormal matrix Q and an upper triangular matrix T 
such that 


0 ]• 


(17) 


(Note that in this case, the "QR" decomposition is in its usual form except that T takes the place of R). Now, 


partition Q = 


; then, 


^ small = I fi f Ql l[ o ]=e[r. 

As above, this factorization can be used to minimize the 2-norm of e = S small - R smaU 0. Denote 

QS~a-[ C d l 

Then, calculate 


(18) 


(19) 


( 20 ) 


The least squares solution is then obtained by choosing 0 such that 

re = c, (21) 

which is a 3x3 system of linear equations easily solved using standard techniques such as Gaussian elimination 
[15]. Therefore, having computed the QR decomposition of R smali , Equations (19) & (21) give an algorithm for 
solving the linear least squares problem considered. 
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Advantages of the Small-Angle Least-Squares Algorithm 

(1) For small angles, this algorithm provides a nearly optimal attitude estimate using an efficient and 
numerically stable algorithm. 

(2) The small angle algorithm explicitly estimates the roll, pitch, and yaw angles (not the full attitude 
matrix). Thus additional calculations are not required to obtain the roll, pitch, and yaw angles from the 
attitude matrix. 

(3) The matrix R sma ii contains many zeros and one can take advantage of this known structure to reduce 
the required computation. This algorithm's computational requirement compares favorably with other 
algorithms as shown below. 

(4) This algorithm works with n>2 measurements, unlike the general algorithm which needs at least three 
measurements. 

Disadvantages of the Small-Angle Algorithm 

(1) The primary disadvantage is introduction of errors due to the small-angle approximation, and thus 
applicability limited to only those cases where small angle approximations are valid. For attitude rotations 
in all three coordinate axes of less than 5°, the error due to the small angle approximations is bounded by 
0.006°, which is acceptable in many cases. 

(2) As for the general least-squares algorithm, this algorithm is not an exact solution of the Wahba prob- 
lem and does not guarantee an orthogonal attitude matrix. If no measurement noise is present (and there 
are no roundoff errors), the only errors are due to the small angle assumptions. If the amount of measure- 
ment noise is small compared to the size of the attitude rotations, the linearization is the main source of 
error and nonoptimality is not an issue. 

3. COMPUTATIONAL REQUIREMENTS 

In this section, we present the computational requirements for the least squares algorithm and compare these 
with the computational requirements of several well-known algorithms. Table 1 below summarizes the computa- 
tional requirements. 

For each algorithm, we address both the general case and the small rotation case. We specifically address the 
cases of two and three vector measurements (i.e. n = 2,3). The two and three measurement cases are the most 
important because most typical spacecraft have either two or three sensors active at a time. Two vector meas- 
urements are sufficient to determine attitude. The three measurement case is important because many systems 
seeking maximal accuracy will include an orthogonal (or near orthogonal) triad of sensing devices. In the next 
section we present a technique for reducing more than three measurements to no more than three for cases 
where the additional measurements can be conveniently clustered (for example, one star tracker tracking and 
measuring multiple stars). 

The computational requirements in this table do not include the calculations needed to compute the so-called 
attitude profile matrix, thus making general QUEST and SVD operations counts independent of n, the number of 
measurements. The least-squares operations counts, on the contrary, do grow with larger n. For the general 
(large-angle) least squares algorithm, only the three-measurement case is included because three vector measure- 
ments are required to obtain a solution. The SOMA (slower optimal matrix) algorithm [9], a variant of FOAM, 
is included for completeness. 

Observations From Table 1 

(1) TRIAD is the fastest two-measurement algorithm, but is error prone because it actually throws away 
some of the measurement information. 

(2) Of small-angle algorithms (excluding TRIAD), QUEST is the fastest, both for two and three measure- 
ments. It is followed by least squares and then FOAM. 

(3) Of the general large-angle algorithms, FOAM is the fastest, followed by QUEST and then least 
squares. SVD is the slowest. 

Table 2 summarizes the primary characteristics of each algorithm. The second column indicates the nature of the 
solution by construction. The third column indicates the types of calculations which make up the bulk of the 
computation for each algorithm. We make one more observation: 
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Table 1 - Algorithm Computational Requirements For The Two & Three Measurement Cases 


Algorithm 


Operations 

cosine I sine I add I multiply j arccos I arcsin I sqrt 


Least Squares 

General. «=3 msmts 0 0 267 264 0 0 6 

Small Angles, «= 2 msmts 0 0 81 78 0 0 3 

Small Angles, « =3 msmts 0 0 117 114 0 0 3 

TRIAD, n=2 msmts 0 0 34 59 0 n , 

QUEST 

General Case, n= 2 & 3 msmts 0 0 217 209 0 0 1 

Small Angles, n= 2 msmts 0 0 42 71 0 0 1 

Small Angles, «= 3 msmts 0 0 64 95 0 0 1 

SVD, n=2 & 3 msmts 0 0 299 336 0 0 0 

FOAM, «=2 msmts 0 0 81 112 0 0 1 

FOAM*, « =3 msmts 0 0 117 148 0 0 1 

SOMA**, 3 msmts 1 0 94 155 1 0 4 

L- 

* assumes one Newton-Raphson iteration 

** SOMA identical to FOAM in two measurement case 

(4) As a preview of Section 5, FOAM appears to have more numerical error. Both QUEST and FOAM 
include some computations which might be sensitive to numerical round-off errors such as trace adjoint 
determinant, and Newton-Raphson iteration. . > J . 


Table 2 - Algorithm Characteristics 


Algorithm 


Solution Characteristic 


Least Squares 
Small Angles 

General Case 


TRIAD 

QUEST 

Small Angles 
General Case 


FOAM 

Polar Decomposition 


Primary Computations 


solves for <t>, 0, & \|/ qr decomposition 

direcdy; near-optimal 

minimizes Wahba’s loss function QR decomposition 
without constraint 


non-optimal; deterministic 

solves Wahba’s problem 
solves Wahba’s problem 

solves Wahba’s problem 
solves Wahba’s problem 
solves Wahba’s problem 


cross products, matrix multiply 

solve Ax = b, A e R 3 ** 
trace, adjoint, determinant, 

Newton-Raphson iteration 

singular value decomposition (iterative) 

adjoint, Newton-Raphson iteration, frobenius norm 

polar decomposition, linear equation solution, 
matrix multiply 


4. AVERAGING OF MEASUREMENTS FOR NEARLY COLLINEAR SENSORS 

we n eSCribe a technique for combining the measurements of nearly coUinear sensors to reduce the 
number of independent measurements which must be processed by the attitude determination algorithm. This is 
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motivated by the following observation: given two or three (non-collinear) vector measurements, adddiond. 
independent ^measurements which are nearly colUnear to any of the original two or thr^ provide very hide ackh- 
tional information. For example, consider a spacecraft with two star trackers whose boresrghts are weU- 
separated from each other. Further assume that each tracker tracks several stars within its field ofvrew andpro- 
duws independent vector measurements for every star it tracks. The stars within each star tracker s bores lght 
are separated by only a few degrees. Therefore, each star tracker is essentially a two-axis sensing device, with a 
^measurement of the axis of rotation about its boresight. A much better three-axis attitude measurement is 
available by combining the measurements of the two star trackers, and two axes of measurement from each 

sufficient. 

The central concept of this section is to combine collections of nearly coUinear measurements by averaging 
Tern r^dien Sg that averaged measurement (along with at least one other measurement) in the attitude 

determination algorithm of choice. 

To carry out this concept, the nearly collinear measurements (for example, the measurements of all stars in a 
I^r Sker) are averaged and normalized in Cartesian coordinates. This results in one measurement vector (and 

its corresponding reference vector) as follows: 


measurement vector: 


m = 
*avg 


s \ + -*2 + 




I St + Si + ’ 


reference vector: 


r avg 


r l + r 2 + ’ ' + r m 

\ \ + r 2+ ' r m ^ 


( 22 ) 


(23) 


It is easy to verify that if the original measurements satisfy (3), then the resulting averages from (22) & (23) 
Sy (3) Therefore, if there are at least two widely separated sets of coaligned or nearly coahgned atti- 
mde m^urements Le rets of measurements can be grouped and averaged as above. TTus results m just a 
(TSr^o or SuS) measurements, each of which might be aggregates of several sets of nearly 
coaligned measurements. Reducing the number of measurements this way has two mam benefits. 

(1) It reduces the operations necessary in the attitude determination algorithm (at least if the least squares 
algorithm is used; some algorithms’ operations counts do not grow with additional measurements). 

(2) It reduces the data flow required across the interface between the star sensor and the central processor. 

5 SIMULATION RESULTS : COMPARISON OF LEAST-SQUARES, QUEST, and FOAM 

in this section we present the results of a simulation which demonstrates several of the concepts ; m i this paper. 
We pSITof .he least-squares algorism wig. the well-known QUEST and FOAM algous 

for the case of small altitude rotations with two vector measurements. We also demonstrate the use of the 
urement averaging technique of Section 4. 

The particular example studied here is a geosynchronous satellite with a star tracker and an earth rensor The 
star tracker can track up to m stars, but the m star mesurements are averaged by the technique of Sect o 
produce one vector measurement The star tracker boresight is assumed to Ire 53 from the earth sensor 
boresieht and there two sensors provide two well-separated vector measurements for attitude determination, 
simulate only the small-angle version of the least-squares algorithm since the general algorithm ineeds iat <*s 
t^fmeasurement vectors It is reasonable to use the small-angle algorithm, because dunng normal operations 
geosynchronous satellites typically maintain their attitudes to within small pert^bauons from ^nominal 
S We also simulate both the general and small-angle QUEST algorithms, and the FOAM algorithm. 

To study the effects of finite precision arithmetic, the simulation includes a model of the round-off error which 

The algorithms are assumed to be implemented in single precision floating- 
^ aSt “ic! 3? nuS? sfoted as 2 !- bit mautissa, sign, and 8-bit exponent. Ibis responds fo the popu- 

lar 1750a architecture. 

First, coordinate frames will be defined after which the detailed implementation of the algorithm w 
described. Figure 1 depicts the geometry. 

5.1 Coordinate Frame Definitions 

The right-handed coordinate frames considered are defined below. 


536 



1. S = Star Sensor Frame . 

This frame has its 3-axis in the direction of the star sensor boresight, its 1-axis in the positive azimuth 
direction of the star sensor, and its 2-axis completes the right-handed triad. 

2. B = Spacecraft Body Frame 

This frame has the spacecraft yaw axis as its 3-axis, the spacecraft pitch axis as its 2-axis, and the space- 
craft roll axis as its 1-axis. 

3. R = Orbiting Reference Frame 

This frame has its 3-axis nadir pointed, its 2-axis orbit normal south, while its 1-axis completes the nght- 
handed triad. 

4. I = Celestial Frame . ... . 

This frame commonly referred to as the Earth Centered Inertial (ECI) frame, has us 3-axis parallel to the 
rotation axis of the earth and pointed north, its 1-axis towards the vernal equinox, and its 2-axis m the 
plane of the equator completing the right-handed triad. 

5.2 Coordinate Frame Transformations 

rr; ( ,r. °" e x^ = > • ■ . * <*• 

shown) of the direction cosine matrix on the arguments. 

1. Transformation From Spacecraft Body To Star Sensor Coordinates 

M : B -» S M = MCa^z . Ea . T*) . ^ 

where 

a xz ■ £ el <y» ~ Azimuth, Elevation, & Rotation Mounting Angles Of The Star Sensor 

2. Transformation From Orbiting Reference Frame To Body Frame 

A :R->B A = A (<t> , 9 , V) 

3. Transformation From Celestial Frame To Orbiting Reference Frame 

C : I — » R C=C(i,a,TOD ) 
where TOD denoles Ure time-oMa, angle, i - orbit IncUnation. and a - right ascension of the ascending 
node. 

5 3 Measurements 

The following measurements are available from the star sensor and the earth sensor to estimate the spacecraft 
attitude. 

1 Star vector measurements expressed in the star sensor coordinate frame S, s, e S i - 1 , 2 , ,m. 

2. The corresponding star vectors expressed in the celestial coordinate frame I from the star catalog (obtained 

as a result of performing star identification), i — 1,2, , m* 

3. Earth vector measurements expressed in spacecraft body coordinates B from the earth sensor, sj? e B. 


(25) 


(26) 


-sinG^z co^el 

cosG^ cos0 £L 


(27) 


where e„ 7 and <b„ are the earth sensor azimuth and elevation measurements, respectively, with respect to 
earth nadir. Our earth "ephemeris" data which is analagous to star reference positions given from the 

catalog is r| = ( 0 , 0 , 1 ) r e R. 
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(28) 


5.4 Collection and Averaging Of Measurements 

ftom "* ort,iun8 refere " w *“• 

(6) and (24). or (30, -I <32, below,. The ■—»« 3*JiS “’ Ua ‘ i ° nS 

S£ 6 B and r§ e R, 

and the measurement and reference vectors for the star tracker are: 

*V«BandO/«*. i-i.2. •• . m . 

The star sensor measurements and reference vpctnre a „ »t,„ 

one aggregate star sensor measurement averaged USUlg equations ( 22 > «“d (23) to make 

SS Implementing the Suboptimal Algorithm 

(expressed in the tody aSIu^ difference between the the measurements 

rotation A (the desired quantity). For the star sensor immurements/ * ,Un8 referenCe frame) ***** 

- M* . 9 . V) *.,11. 


where 


(30) 


"avg 


M T sZt and = £>_. 


For the earth sensor measurement. 


«*• 


minimi2e IW -4 (4. e.y) rid. Where r| = 


Combining Equations <2** (28), and (29), rearranging 
squares problem (15) reduces to 


nunimize ||5 - J5d«. or minimize 


(31) 


(32) 


terms, and removing one extraneous equation, the least- 


03) 


S *vg,l - Ravg, 1 
S avg2 ~ 


0 ~~ R avgJ 
0 

~ R avg ,1 

V] 

S avg$ ~ Ravg, 3 

— 

~~ R avg ,2 Ravg ,1 

0 

e 

S EA 


0 -I 

0 

Mil 

S E£ 


. 1 0 

0 

II 


— w.. „ a linear measurement equation in 6 0 and w y a— . , ., t 

. ^ °» 31,(1 V- x av g ,i denotes the i’th entry of the vector y -rt.^ 

* fte " 0 “ ned *» * - **— * E^aata (19, aid <21, a* di^ 

““ T 1 ' f0,m ° f ““ «*"* la Equ a,io„ (33). 
the satellite body axes will not deviate from the oSSnc reScT^^* ^ 311816 assum P tion is valid; 

during normal operations (including statiordceeoinei tJZI IT k*" 16 m ° re lhan a few tenths of a degree 
m cartesian coordinates using equations (22) and 8 (23> nmvidint mea f UI ^ ments ^d references are averaged 
which reduces subsequent computation and limits data flow ^ tariX* meaSUrement " ftom *•» star ^or 


5.6 Simulation Results 

For our simulations, we use (he following reference vectors: 


*«»r 


R avgl = 


0 

-sin53° 

-cos53 e 


(34) 

S a,,i = + «( , 1 = 1,2 — 


539 


where 




COSVCOS0 cos\j/sin0sin<jH*sin^cos<t> 
-sinvycosO -sinysin6sin<H^ s Vros<> 
sin0 — cos0sin$ 


-cos\jfsin0cos(j^+sin\^sin^ 

sinV s ^0 cm 9+ cos V sm 4 > 

cosBcosO 


♦ *=» = ¥= * 


(36) 


and is a vector of zero-mean Oaussian whife noire 

*£££7“ VTJZZZ “ tove u " Uy 2 ' non "' 

0* pammem, ^ repress -» ^ — „* = 0. ro arse, dm 

^c“-o7^! ~n, * 0 ,o assess esdmadon acorns in fhe pmsenee of sensor noise (and 

round-off error). Algorithm accuracy is computed by 

**-[<$- <W) 2 + (8 - e ^) z + W - 


(37) 


Of course, when no measurement noise is “® d ’ loriAm^dmeffo sUdsUcal effects and then 

measuremenl noise is included ■ « «-. ^^^“flnj-off enors; when », • 0. dm medic 

“.tL-Ti' ~ e^.'we sness d,ar ihe nmneHcaf resnhs am mem, e*P— . no, 

validated by any rigorous numerical analysis. 


Table 3 - Simulation Results : Algorithm Accuracies 


CASE 


A 

B 

C 

D 

E 

F 

G 

H 


ROTATION SIZE 

9^* dc F* 


0 

0.001 

0.01 

0.1 

0.1 

0.1 

0 

0 


measurement noise level 

0* , degree* 


0 

0 

0 

0 

0.0001 

0.01 

0.001 

0.01 


ESTIMATION ERROR, t aU , degrees 


SMALL ANGLE 
LEAST SQUARES 

2.0x1 CT 6 
3.1x10'* 
3.6X10- 6 
2.7xl0~ 4 
2.8x10^ 
0.014 
0.0014 
0.014 


general quest 
0.0 

4.0X10" 6 
1.8x10^ 
1.9XKT 6 
1.4xl(T* 
0.014 
0.0014 
0.014 


SMALL ANGLE QUEST 


0.0 

4.0xl0~* 
1.6xl0" 6 
1.5X10" 4 
1,9x1 0" 4 
0.014 
0.0014 
0.014 


FOAM 

0.0 
2.5xlCT 5 
2.8xl0“ 5 
5.8xl0r 6 
1.4x10“ 
0.014 
0.0014 
0.014 


| \ u — 

, of - A of fl fflifiv wide range of attitude errors and noises, 
The results summarized in Table 3 are ^ repre jati y for ^ cases> the least-squares algorithm is 

although all would be considered small-angle cases-W mysteriously, in Case A). Its accu- 

less affeemd by finite precision arilhmeuc than dm ^ fr0 ’ Table 3, we conclude 

2 torTsCrfai^cTelaf ^ algorithm provides acemaey essendaliy identical . QUEST and 

^FOAM algoridim appears d> be mosf snscepdble d> round-off error and. dms, ils esttmadon accuracy 
degrades as measurement noise decreases. 

6. CONCLUSION n9n .r we introduce a new 

A number of algorithms ezisl for ;J°2a fsoto7 <T2teT2blem. if is especially attraclive for cases 
suboptimal least-squares algorithm for the elution smaU -angle case, the least-squares algorithm is quite 
where attitude rotations are known to , s ' . . ODerat j ons The computational requirements of the least 

efficient and can be performed with numencally for ^ wo mA three measurement cases. If 

squares algorithm are compared wi oe [' v al] ang j e quest is the most efficient algorithm, followed 

2^7— 22e which reduces dm number o, vecror measmemems dm. any 
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£rnLTa, P ^ - — - ta. as . ta. 
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appendix - algorithm operations counts 

In this appendix, we preaenU 

These results are presented in Table 1 of the max y . ^ f various algorithms, and 

» * « — - - 

lack of space. 

‘of £ 

lions are required. The results are shown in Table Al. 


Table Al - Small Angle Least Squares Operatic 

ns Count 


OPERATION TYPE 

additions 

multiplies 

sqit 


36 

36 

3 

QR Decomposition 




(Stewtit [15], Alg. 3.*, p. 236) 

30 

30 

0 

Use QR for Least Square* 




(Stew.it [15], Alg. 3.7, p. 234. three rime*) 


6 

0 

Solve upper triangular 

3 



system 

6 

0 

0 

form "measurement" 



- — 


81 

78 

3 

TOTAL 






The calculations required to solve an upper triangle 3x3 system were counted by hand. The fon * 
ZZZZJL « «* - *. calculation paired to form J of Eqnate. (.5) . to man, bod, of thts 

paper. 

Small Angle QUEST Operations Count 

computations monte! for smaU angfc OUST « < £££.* j%2!7£ 

sarsrjirs!: *• ■*-— - *— 1 * ™ e a2 - 

notation is from [5]. 


Table A2 - Small Angle QUEST Operation* Coo 

nt 


OPERATION TYPE 

additions 

multiplies 

sqrt 

- 

9 

24 

0 

form S o 

3 

0 

0 

calculate A *2 1 — S$ 

9 

18 

0 

form Z 

18 

18 

0 

solve Ax -2 using 




gaussian elimination (Stewart [15], Alg. 1.3, p. 131) 

3 

8 

l 

form if 

0 

3 

0 

multiply elements by 2 





42 

71 

1 

TOTAL 
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General QUEST Operations Count 

The general QUEST operations count is summarized in Table A3 below. The notation in the table is consistent 
with [5]. 


Table A3 - General QUEST Operation Count 


OPERATION TYPE 


farm S 4 times 
form O 4 times 
form det(5) 4 times 
form K 4 times 
form CO 4 times 
form Z 
form O 2 — K 
form a 2 + Z T Z 
form 8 + Z T SZ 
form Z T S 2 Z 

one newton-raphson iteration 

form a, 0, CO 

form (a / + 0S + S 2 )Z 

form 

post route 
TOTAL 


additions 


36 

8 

20 

48 

16 

9 

1 

3 

9 

14 

10 

5 

36 

2 

0 

217 


multiplies 


sqrt 


0 

0 

36 

72 

8 

18 

0 

3 

12 

15 

4 
2 

33 

4 

2 

209 


0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 


A number of the operations are done four times to find and implement pre-rotations which avoid the 180° rota- 
tion case. 

FOAM Operations Count 

Table A4 below summarizes the opeations count for the FOAM algorithm. Notation in the table is consistent 
with [9]. 


Table A4 - FOAM Operations Count 

OPERATION TYPE 

additions 

multiplies 

sqit 

forma X 

1 

1 

1 

0 

farm K 

1 

2 

form ^ 

0 

I 

o 

form \\B\\p 

8 

9 


form \\adj{B)\\p 

17 

27 

o 

farm (K + llfi ll^)/£ 

1 

10 

o 

form \adj(B T y{ 

0 

10 

o 

form BB t B 

36 

54 

0 

divide above by £ 

0 

9 

o 

add and subtract three matrices 

18 

0 

0 

TOTAL 

81 

112 

1 


For the two measurement case, no Newton-Raphson iteration is required since X admits a closed form solution in 
this case. 
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